
void setupRelay()
{
  Serial.println("Inicializando reles");
  //OJO, poner los niveles de los pines antes de inicializarlos como salida,
  //sino con cada reseteo tendremos un cambio de nivel en el pin que disparará
  //el relé
  setRelayStatus(OUP, false);
  setRelayStatus(ODOWN, false);
  setRelayStatus(OLEFT, false);
  setRelayStatus(ORIGHT, false);

  pinMode(RELAY_UP_D_PIN, OUTPUT);
  pinMode(RELAY_DOWN_D_PIN, OUTPUT);
  pinMode(RELAY_LEFT_D_PIN, OUTPUT);
  pinMode(RELAY_RIGHT_D_PIN, OUTPUT);
}


void setRelayStatus(int pin, bool state)
{
  if (state)
    digitalWrite(pin, LOW); //On
  else
    digitalWrite(pin, HIGH); //Off
}



void moveUp()
{
    setRelayStatus(OUP, true);
    setRelayStatus(ODOWN, false);
}

void moveDown()
{
  setRelayStatus(OUP, false);
  setRelayStatus(ODOWN, true);
}

void stopVertical()
{
    setRelayStatus(OUP, false);
    setRelayStatus(ODOWN, false);
}

void moveLeft()
{
  setRelayStatus(OLEFT, true);
  setRelayStatus(ORIGHT, false);
}

void moveRight()
{
  setRelayStatus(OLEFT, false);
  setRelayStatus(ORIGHT, true);
}

void stopHorizontal()
{
  setRelayStatus(OLEFT, false);
  setRelayStatus(ORIGHT, false);
}



